/*
	FreeRTOS.org V4.4.0 - Copyright (C) 2003-2007 Richard Barry.

	This file is part of the FreeRTOS.org distribution.

	FreeRTOS.org is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation; either version 2 of the License, or
	(at your option) any later version.

	FreeRTOS.org is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with FreeRTOS.org; if not, write to the Free Software
	Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

	A special exception to the GPL can be applied should you wish to distribute
	a combined work that includes FreeRTOS.org, without being obliged to provide
	the source code for any proprietary components.  See the licensing section 
	of http://www.FreeRTOS.org for full details of how and when the exception
	can be applied.

	***************************************************************************
	See http://www.FreeRTOS.org for documentation, latest information, license 
	and contact details.  Please ensure to read the configuration and relevant 
	port sections of the online documentation.

	Also see http://www.SafeRTOS.com for an IEC 61508 compliant version along
	with commercial development and support options.
	***************************************************************************
*/


/*
 * Implementation of pvPortMalloc() and vPortFree() that relies on the
 * compilers own malloc() and free() implementations.
 *
 * This file can only be used if the linker is configured to to generate
 * a heap memory area.
 *
 * See heap_2.c and heap_1.c for alternative implementations, and the memory
 * management pages of http://www.FreeRTOS.org for more information.
 */

#include <stdlib.h>

#include "FreeRTOS.h"
#include "task.h"

   #include  "types.h"
   #include  "board.h"
   #include  "console.h"

   U32 LV_Allocated;
   U32 LV_LastPtr;

   static char ucHeap[ configTOTAL_HEAP_SIZE ] __attribute__((section(".heap_freertos")));


/*-----------------------------------------------------------*/

void *pvPortMalloc( size_t xWantedSize )
{
void *pvReturn;

        //in this context, free is not called, 
        //therefore, simple mamory allocation by moving 
        //a pointer is sufficient
        //the reason is that ARM tools malloc is not 
        //working as expected, it stops allocating 
        //much before the pool limit. strange.  

        if(LV_LastPtr==0)
        {
           LV_LastPtr=(unsigned int) ucHeap;
        }

        if((xWantedSize & 3)!=0)
        {
           xWantedSize = (xWantedSize & ~(3)) + 4;
        }


	vTaskSuspendAll();
	{
                LV_Allocated+=xWantedSize + 4;
                //pvReturn = malloc( xWantedSize );

                pvReturn = (void*)(LV_LastPtr + 4);
                LV_LastPtr+=xWantedSize;

	}
	xTaskResumeAll();

	return pvReturn;
}
/*-----------------------------------------------------------*/

void vPortFree( void *pv )
{
	if( pv )
	{
		vTaskSuspendAll();
		{
			free( pv );
		}
		xTaskResumeAll();
	}
}



U32 heap_GetAllocated(void){
	return LV_Allocated;
}


U32 heap_GetTopPtr(void){
	return LV_LastPtr;
}

